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SPECIFICATIONS 



7607 * 



1. Name of invention 

Attitude controlling method in coaxial two wheeler 

2. Claim 

[1] With a coaxial two wheeler comprised of a pair of 
wheels (2, 3), axle (1) between the wheels (2, 3), car body (4) 
rotational ly supported on the axle (1), wheel driving motor (7) 
mounted on the car body (4), microcomputer (16) for controlling 
the wheel driving motor (7), and angle detection device (11) for 
detecting the angle of the car body (4); 

the slanted angle (91) of the car (4) detected by the angle 
detection device (11) is sampled at short intervals (At); the 
sampled angle (01), of the car body (4) used as conditional 
variables and feedback gain (K) used as a coefficient are 
respectively entered into the computer (16) to substitute and 
compute the pre-established input computation equation (60) to 
generate a control torque (T3) for the motor (7); and the 
computer (16) controls the motor (7) according to the computed 
control torque (T3). 

[2] With a coaxial two wheeler comprised of a pair of 
wheels (2, 3), axle (1) between the wheels (2, 3), car body (4) 
rotationally supported on the axle (1), wheel driving motor (7) 
mounted on the car body (4), microcomputer (16) for controlling 
the wheel driving motor (7), primary angle detection device (11) 

* Numbers in the margin indicate pagination in the foreign text. 
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for detecting the angle of the car body (4), and secondary 
detection device (14) for detecting the rotational angle of the 
wheels (2, 3); 

the slanted angle (01) of the car (4) detected by the 
primary angle detection device (11) and rotational angle (63) of 
the wheels (2, 3) detected by the secondary detection device (11) 
are sampled at short intervals (At); the sampled angles (61) of 
the car body (4), sampled rotational angle (63) of the wheels (2, 

3), and angle speed (61, 63) computed based on those sampled 
angles (01, 03) are entered into the computer (16) as conditional 

variables. Those values (61, 03, 01, 03) and feedback gains 

(Kl, KT) used as coefficients are substituted in the pre-stored 

control equations (10, 49, 51) stored in the computer (16); a 
control torque (T3) of the motor (7) is computed based on this /60S 
computation; the motor (7) is operated by the computer (16) 
according to the computed torque (T3). 

[3] With a coaxial two wheeler comprised of a pair of 
wheels (2, 3), axle (1) between the wheels (2, 3), car body (4) 
rotationally supported on the axle (1), attitude control arm (6) 
slantingly clamped to the car body (4), wheel driving motor (7) 
mounted on the car body (4), attitude control arm driving motor 
(9) mounted on the car body (4), microcomputer (16) for 
controlling the wheel driving motor (7) and attitude control arm 
driving motor (9), primary angle detection device (11) for 



detecting the angle of the car body (4), secondary detection 
device (14) for detecting the rotational angle of the wheels (2, 
3), and third detection device (15) for detecting the attitude 
control arm angle ( 6 ) ; 

the slanted angle (61) of the car (4) detected by the 
primary angle detection device (11), rotational angle (63) of the 
wheels (2, 3) detected by the secondary detection device (11), 
and attitude control arm angle (62) detected by the third 
detection device (15) are sampled at short intervals (At); using 
the sampled angles (61) of the car body (4), rotational angle 
(63) of the wheels (2, 3), slanted angle (62) of the attitude 
control arm (6), and angle speed (61, 63, 62) computed based on 
the sampled angles (61, 63) as conditional variables and feedback 
gains (Ki, Kt) as coefficients, those values (61, 63, 62, 61, 63, 
62) are substituted in the pre-entered control equations (20, 49, 
51) stored in the computer (16); control torques (T3, T2) for the 
wheel driving motor (7) and attitude control arm driving motor 
(9) are computed based on the values obtained from the equation 
computation, and the computer (16) controls the wheel driving 
motor (7) and attitude control arm driving motor (9) according to 
the control torques (T3, T2). 
3. Detailed explanation of this invention 
[Industrial field] 

This invention pertains to an attitude controlling method 
for a coaxial two wheeler. 




[Conventional technology] 

A coaxial two wheel vehicle having wheels at both ends of 
one axis can be made into more compact flat shape type device 
compared with a four wheel or three wheel car. However, it is 
not practically usable unless its attitude is stably controlled. 
Therefore, an attitude control method was developed, in which a 
control arm is hung from the car body supported on the drive 
shaft of the coaxial two wheeler to control the angle of the 
control arm against a car body. 
[Problems to be solved by this invention] » 

However, with the attitude control method which drives a 
control arm in the direction opposite to the slanting direction 
of a car, not only does this method create a control delay caused 
by non-linear elements (e.g., non-sensitive area of the control 
arm driving motor, back-rash of the gear-transmission system, 
etc.), but also it is unable to eliminate the noise in the angle 
computation performed based on the short-interval sampling of car 
angles and control arm angles. Therefore, stable controlling on 
the car attitude using an actual feedback control is difficult. 
[Constituents of this invention] 
[Method to solve the problems] 

With the first claim of this invention, the tilt angle of a 
car detected by the first angle detection device is sampled at 
short intervals, and the control torque for the wheel driving 
motor is computed based on the sampled data, and the feedback /609 
control is performed on the wheel driving motor based on the 
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computed control torque. As a result, this makes the wheels to 
move in the slant direction of tfie car to provide a recovery 
moment to the car. With this method, despite the fact that the 
control torque is immediately computed from the sampled slant 
angles of the car, sufficient stable attitude control can be 
provided . 

With the second claim of this invention, the tilt angle of a 
car detected by the first angle detection device and wheel 
rotation angle detected by the secondary angle detector are 
sampled at short intervals, and the angle speed of those angles 
are computed. The control torque for the wheel driving motor is 
computed based on the sampled values and computed angle speeds to 
control the wheel driving motor using a feedback technique. As a 
result, the wheels can be operated in the slant direction of the 
car body to provide a recovery moment to the car. With this 
method, the use of angle speed computed from the sampled angles 
of the wheel and car body can further improve the attitude 
stability control. 

In the third claim of this invention, the tilt angle of a 
car detected by the first angle detector, wheel rotation angle 
detected by the secondary angle detector, and slant angle of the 
attitude control arm detected by the third angle detector are 
sampled at short intervals. Control torques for the wheel 
driving motor and attitude control arm driving motor are computed 
from the sampled values to control the wheel driving motor and 
attitude control arm driving motor using a feedback technique. 



As a result , while the wheels are operated in the slant direction 
of the car body, the control arm rotates in the direction 
opposite to the slant direction of the car to provide a recovery 
moment to the car. With this method, the use of an attitude 
control arm can provide more improved control over the wheels and 
car body than the first and second methods. 
[Operational example] 

The following explains the operational examples of this 
invention while referring to the figures. 

As shown in Figure 1, a pair of wheels (2, 3) are attached 
to both ends of an axle (1) and, in turn, a square frame-form car 
body (4) is tiltably supported on this axle (1). A fulcrum shaft 
(5) is rotating installed and supported in an upper part of the 
car body (4), and in the center of the fulcrum shaft (5), an 
attitude control arm (6) with a weight (6a) is slantably clamped 
thereto. A reciprocally rotatable car driving motor (7) is 
mounted on the car (4) immediately below the weight (6a). As 
shown in Figure 2, a deceleration gear array (8) is positioned 
between the driving shaft (7a) of the motor (7) and car axle (1), 
allowing the decelerated rotation of the wheel driving motor (7) 
to be transmitted to the wheel axle (1) to make the wheels (2, 3) 
reciprocatingly rotate. A reciprocatingly rotatable attitude 
control arm driving motor (9) is mounted on the car (4) 
immediately above the shaft (5), an array of decelerating gears 
(10) are placed between the driving shaft (9a) of the motor (9) 
and shaft (5). With this structure, the decelerated rotation of 
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the attitude control arm driving motor can be transmitted to the 
shaft (5) to guide the attitude control arm (6) in the 
backward/forward directions . 

The primary rotary encoder (11) is attached to the side 
surface of the car (4), and the rotational shaft (11a) is placed 
on the extension line of the axil (1). A pair of contact pieces 
(12, 13) are diagonally mounted onto the rotational shaft (11a) , 
and the tips of the pieces (12, 13) contact and engage onto the 
floor- With this structure, the tilt angle of the car (4) to a 
vertical line can be detected. The secondary rotary encoder (14) 
is mounted onto the wheel driving motor (7), and the third rotary 
encoder (15) is mounted onto the attitude control arm driving 
motor (9), detecting each turning angle of these wheels (2, 3) 
and a tilt angle to a vertical line. 

A microcomputer (16) for controlling the system is mounted 
at the lower, area of the car body (4), and the detection signals 
transmitted from each rotary encoders (11, 14, 15) are inputted 
into the microcomputer (16) which computes the control torques 
for the wheel driving motor (7) and attitude control arm driving 
motor (9) on the basis of these inputted signals, thus the motors 
(7, 9) can be controlled with the force equivalent to the control 
torques. [1] Figure 3 shows the dynamic model of the simplified 
system exhibited in Figure 2. A wheel area (17) composed of a 
wheel part (19) consisting of an axle (1) and wheels (2, 3), 
motors (7, 9) supported by the car body (4), control computer 
(15), and car body (4), is expressed as a "material point- at a 
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distance (jel) from the axle (1); and an arm area (18) composed of 
an attitude control arm (6) and weight (6a) is expressed as a 
-material point 1 * at a distance (42) from the shaft (5). The 
wheel part (19) is considered to have the center of gravity on 
the axle (1), and the distance between the axle (1) and shaft (5) 
is 4. 

The motion energy (Ko) of the dynamic model is a total of 
motion energy (Kl) of the car body (17), motion energy (K2) of 
the arm part (18), and motion energy of the wheel part (19). The 
following describes the expression of each motion energy (Kl, K2, 
K3) using the coordinate elements of the x-y coordinate shown in 
Figure 2 where the mass of the car body (17) is expressed as ml, 
the mass of the arm part (18) is expressed as m2, and the mass of 
wheel part (19) is expressed as m3: 

Kl = (1/2) ml(xl 2 + yl 2 ) 
K2 = (1/2) m2(x2 2 +-^2 2 ) 
K3 * (1/2) ro3x3 2 

where x and y designate the first level of differential of x and y. /611 

When the tilts of the car part (17) and arm part (18) to a 
diagonal line are expressed as 01 and 02; the rotational angle of 
the wheel part (19) is expressed as 03; the semi-diameter of the 
wheels (2, 3) is expressed as r; inertia moment in the direction 
of axle (1) of the car part (17) is expresses as Jl; and inertia 
moment in the direction of shaft (5) of the arm part (18) is 
expresses as J2; the following expressions are formed: 
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Kt -(1/2) mi 

x {( r d l 8 x -cos 8 !)»♦ t i* 6 i* - sin* 8 , | 
"(1/2) m t 

x< r 1 * 3 N Zri, 0 3 d l -cos ',ft£ t *0,>) 

- (1/2) mi r 1 b 3 * 
♦ mi r * I t * s 0 , co$ *i*U/2) J i * i* 

K2 -(1/2) ni 

+ <- * *l - sit * |- I , « , . ,u » t >) 
-(1/2) o> } r« * s * 

+ n » rffj(**l . C ot *i-£t ♦ cos 8 t ) 

- m 2 £ £ 2 * , 8 2 ■ cos ( 8 |- * 2 ) 

Ml/2) m, I * i«t(l/2) Jj j* 
K3 - (1/2) m 3 r * * ,» 

where 81, 02, and 83 are the first-level differential of 01, 02, 
and 03. 

As for the motion energy (K 3 ) of the wheel part (19), 
rotational energy based on the inertia moment in the direction of 
the center of the gravity exists. When the inertia moment is 
designated as J 3 , the movement energy (K 3 ) can be expressed as 
below: 

K3 = (1/2) m3 r 2 83 2 + (1/2)J3 83 2 

Therefore, the motion energy (K) can be expressed as below: 

K» • K i ♦ K j + K j 
-(1/2) • (Ji»m 2 £«) *,>t(l/2> J 2 9 j* 
+ (1/2) -(ro t r^mj r*»m 3 r *» J 3) 3 * 
-m 2 t 2 t 9 1 9 2 - cot ( *|- 8 2 > 
+ ( m 2 £|»m 2 £) r b x 9 , . C os 9 X 
- m» t 2 t 9 2 8 j - cos 82 

- • ( 1 ) 

The positional energy (P) can be expressed as below when the 
gravity acceleration ratio is expressed as g: 
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P-( n»l (|(D2 I ) g ♦ COS * I 

- mj it k - cos 0 j 

• • (2) 

The energy loss (D) can be expressed as below when the 
viscous friction coefficients of car-part motion (17), arm-part 
motion (18), and wheel-part rotation (19) are respectively 
expressed as f v f 2 , and f 3 : 

D - (1/2) f 2 * + (1/2) h »j» 

- - • (3) 

Since the torques (T2, T3) respectively exist for the arm 
part (18) and wheel part (19), a Lagrange motion equation 
described below can be established: 

4/<l«*/Hl • K - * / * * I * K 
+ i/J «i « P • D-TI 

(I - 1 . 2 . 3 ) 
• - ■ ( 4 ) 

where d/dt is an ordinary differential equation., and 6/6&L and 
6/60i are a partial differential equation. 

By substituting equations (1), (2), and (3) in Equation (4) 
and once Equation (4) is organized, the following equations can 
be established: 

A | * i>B| -co* ( 9 t ~8 2 )8 7 
+ C t -cos tf, *3*D| - sii ( 8 % .8% ) 8 x * 

♦ £ I • sit 8 , ♦ f i 6 i - o 

- * * ( 5 ) 

B i -cos ( * ,- a ,) a b 2 8 a 
+ C 2 cos 8 t «i»Di - iU ( 
+ Ei • s i ■ 0 * ♦ f 2 * 2 - T l 

• * • (6) 
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( 7 ) 



where 



a 

"1 




J. + nu jB 2 


B 1 




-nig je -1 je 


c, 




(ntj £ + nig £)r 


D 1 






E 1 






B 2 






C 2 




-n^ j£ 2 r 


D 2 




-ITL, £ Z SL 


E 2 




-m2 X 2 g 


C 3 




(ia, +11^ + m 3 )r 2 J 3 


D 3 




-(ia, £ + SL)r 


E 3 




-n^ je 2 r 



[2] Next, the following explains the design of the linear 
control system for the dynamic model shown in Figure 3: 
The following approximation is performed under the 
assumption that the dynamic model shown in Figure 3 is 
consistently controlled so that 91 and 82 never become 
excessively high values. 

*»» 9 I - 8 I sin 0 2 * 0 i 

coi *l -cos e x -cos (tf t -*2 ) * I 

si* 9 2 ff**-*iit (tf|-tf 2 ) e ,» 



12 



Based on this approximation, the equations (5), (6), and (7) 
can be made into the following linear equations: 

? i - An* MAi2*2*Aia9|tAi4*2*BiiT2 

- • ■ ( 8 ) 

*l - An 9 t« A 22 * l» A 23 * I* A tt i l« B itTj 

• • ( 9 > 

where 

A 12 - - B 2 B i/ A 
*HTf| B i/A 
An--B» A|/A 
A 24- - f i A i/A 
B21--A1/A 



An - E 1 B 2/ A 
Au- f 1 B2/A 
A 21 - - B| B 1/ A 
A»i - - f 1 B 1/ A 
B 11 - B i/A 
A - B i*- A| Bj 



Assuming that xl = 81, x2 = 62, x3 = 61, and x4 = 62, the 
following vector and matrix display are performed: 



x-f!jj ] a-' 5 



- f 0 
B - 



f ! 0 1 0 1 
0 0 0 1 

( A 1 1 A 12 A 13 A i< 
A 21 A22 A 21 A 24 ; 

I 0 ] c-- f 1 0 0 0 I 

B 21 ' 



u = T 2 



The following conditional equation and output equation can 
be obtained using the vector and matrix display described above : 



x < t ) -X- x ( t ) * b - « ( t ) 

-(10) 

Y ( I) - C" - X ( 1 ) 

• • • (I I) 



By Laplace-transforming the conditional equation (10), the 
following equation can be established: 
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Therefore, • 

X ( s > - ( iT-X)'b • u ( i ) 

• • • (12) 

where I is a unit matrix, (si - A)^ 1 B is a reversed matrix of (sT 
-A). 

By substituting the equation (12) in the output equation 
(11), the following equation can be established: 

Y(s>-~C<sX-X>B*u<»> 

• • - ( I 3 > 

-> 

The function expressed as Y (s)/u(s) is called "transfer 
function" based on the control theory, and is expressed as the 
following polynomial equation: 

Y <-« > / u < s ) 
- k ( s - # i)( s - # t)< * - * jM * - • «) 
♦ i-'i) 
••(14) 

(s - Al), (s - A2), (s - A3), and (s - A4) in Equation (14) 
are characteristic polynomial equations, k is a gain, and Ai (i = 
1, 2, 3, 4) is called "pole". When the pole Ai exists on the 
right half of the complex variable plane, that is, the real 
values are positive, the system expressed with equations (10) and 
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(11) is known to be unstable; whereas when the pole Ai exists on 
the left half of the complex variable plane, that is, the real 
values are negative, the system expressed with equations (10) and 
(11) is known to be stable. For example, when the system 
parameters of the dynamic model shown in Figure 3 are the 
following values, the pole is confirmed to exist on the right 
half on the complex plane. 







2.59 Kg 




Z 


■ 0.318 m 






1.52 Kg 




2 


= 0.17 ra 


m 3 




0.36 Kg 




SL 


= 0.20 m 


J i 




0.108 Kgm 








J 2 




7.01 x 10 


Kgm 






J 3 




5.00 x 10 


Kgm 







r = 4.5 x lO-Zra 

f, = 6.0 x 10 Nms 
f 2 = 4.40 x 10 Kgm 
f 3 = 4.40 x 10 Kgm 

In order to stabilize the dynamic model shown in Figure 3, 

the control input u(t) must be added to transfer the unstable 

condition to the stable condition. To achieve this, the 

existence of u(t) must be guaranteed. If u(t) exists, the 

dynamic model expressed as Expressions (10) and <11) is 

controllable. It is a known factor based on the control theory 

that the necessary/sufficient condition is that the ranks fB, AB, 
-» -> iff 

~"~2 — 3 

AB, AB] of a matrix called controllable matrix match the 
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conditional variables (xl, x2, x3, x4). The system expressed 
with equations (10) and (11) is controllable as it satisfies this 
necessary/sufficient condition . 

To transform the system expressed as equations (10) and (11) 
to the system to which conditional feedback control is added, the 
following equation is used: 

•■••(IS) 



where K is a vector called conditional feedback 



gain, and c is a 



scaler. 



By substituting the equation (15) in equations (10) and 
(11), the following conditional equation and output equation 
be obtained: 



can 



X ( t ) - (a + B K) X ( t ) 
+ c B • V ( t ) 

Y C t ) -~C - X ( t) 



• (16) 

* (17) 



By Laplus-transforming the conditional equation (16), the 
following equation can be made: 



X < * ) - ( » I - A - B K ) c B • V ( , ; 

•••(18) 



By substituting equation (18) to the output equation (17), 
the following equation can be made: 



Y (») - C it I - A - B K ) c B - V (a) 
• • • (19) 



16 



Therefore, inherent polynomial of the matrix (A + BK) 
matches 

the characteristic polynomial, thereby the inherent value 
of matrix (A + BK) agree with the pole. 

It is an established factor based on the control theory that 
equations (16) and (17) must be controllable for matching the 
characteristic polynomial expressed as equation (19) with Monique 
polynomial [i.e., necessary/sufficient condition for 
optionally establishing the inherent value of matrix (A + BK)]. 
Therefore, by appropriately establishing the conditional feedback 

-» 

gain K, the system can be stabilized by positioning a pole at an 
appropriate location dn the right half of the complex plane. 

When c = 0, the conditional equation (16) designating the 
controllable system shown in Figure 3 is expressed as below: 

X ( t ) - (X+BK) x ( t ) 

that is, 

u (t) -if.'X (t) • • • t 2 0 ) ^ 

-> 

The feedback gain K in equation (20) can be obtained by the 
following method: 

(1) Select preferable four different and symmetrical poles Si (i 
= 1/ 2, 3, 4). 

(2) Compute the following equation after selecting the real 
number (gi) when all the poles (Si) are real numbers. 
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Fi = (Si • I - A) Bgi 
(3) When all the poles (Si) are complex numbers a + 13 j (j is an 
imaginary number), Si + 1 is made into a conjugate root al - 
fli j, and appropriate real numbers gi, gi+ 1 are selected, 
then, the following equations are computed: 

f i - I ( <ri T-X) B*u0i B t Hi ) 
♦ ( (or | T-X) »»*l*Tl 

r i« i - { («i T-X) b g ui»* i Be i ) 

+ i ( a \ T-X) 1 ♦ 0 l*Tl 

With those computations , the feedback gain K becomes the 
following: 

•tlMl.gj.I* J t t I. f *. f J. f « ) 
• (21) 

[3] In special cases of the dynamic model shown in Figure 3, 
that is, the coaxial two wheelers from which the attitude control 
arm (6) is removed (shown in Figure 4 and its dynamic model is 
shown in Figure 5 ) „ The Lagrange motion equation of the dynamic 
model shown in Figure 5 can be obtained by the following equation 
using equations (5), (6), and (7): 

M, b , - o 

• (22) 

C i ♦ c o s 9 , If n c j ? j 

'♦ D 3 - si» o ! b ,»» r , b , -u 

■ • ' (23) 
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The following approximation is performed with the equations 
(8) and (9): 

With this approximation, equations (22) and (23) are linear- 
processed as described below: 

>*l - Au«l«Ai|i|»Ani|*BiiTi 
.--(24) 

*j - Aai * l*Aiji i» A24*»»B tlTi 

•(25) 

where 

Alt-Ei Cj/A A| 3 --fi Cj/A 

Am- t j Ci/A An-Ei Ci/A 

An-il Cj/A Au--I> A|/A 

B11--C1/A B21-A1/A 
E 1 - - m 1 g t 1 C 1 - m 1 £ t r 

Ci - (mi»mj)r* + J j A| - J j 
A -A, C) - Ci 1 

Assuming that xl = 61, x2 = 63, x3 = 61, and x4 =63, the 
following vector and matrix display are performed: 



— * * 1 * __ #0.0 1 0 

X- I M I A - I 0 0 0 I 

* a I A 11 Ait A u A 14 

* X 4 ' 1 A 21 A 22 A 2S A 14 

B - tO 



B 11 
Bit 



t l U V V \ 

I 0 1 0 0 I 



u = T3 

Using those vector and matrix display, the following 
conditional equation and output equation can be obtained: 
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X(t)-A»X(t)+B*u(t) 

• • • (26) 

Y ( t ) -"C • X { t ) 

• • • (2 7) 

Parts (a) and (b) in Figure 6 show the computer simulation 
results for the equations (26) and (27) using the feedback gain K 

expressed as expression (21) established according to the methods 
(1) ~ (3) described above . With those simulations , the numeric 
value differentiation method described later is used. In Part 
(a) in Figure 6, curve (CI) shows the variation of the tilted 
angle (91) of the car body part (17), and curve (C2) shows the 
variation of the rotational angle (63) of the wheel part (19). 
In Part (b) in Figure 6, curve (C3) shows the variation of the 
tilted angle speed (91) of the car body part (17); curve (C4) 
shows the variation of the rotational angle speed (93) of the 
wheel part (19). The parameters and conditions are established 
as following: 

«i - 2. 7 9'k f £ - o. 3 1 8 m 

mi " 0 fc « < t - 0. 1 9 m 

«»J - 0 . 3 6 k g * 2 -0 m 

Ji - 0 . 1 2 2 3 1 k ( m 

J t - 0 km 

Jj-5. OOxiOkfm 

r -4.5 x 1 o ~m 

fi - 6. 8 6 x 1 0 N m s 

f a - 0 n m * 

t i - i . 40xio Nm« 

S i - (- 5 - 4 j . - 6 ± 5 j ) 

< i - r . 2 . 3 . 4 ) 

K - (4.88. 1. 31. 5.37. 6.00 ) 
X (0) - (0. 0. «/lo, 0] 
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Note that X (0) = [0.0, re/10.0] expresses the initial 
condition; disturbance re/10 (rad/s) is provided to the car part 
(17); and 5 ms is used as simulation interval At. The simulation 
results shown in Parts (a) and (b) in Figure 6 indicate that the 
car part (17) can be returned to the balanced position (91 = 0) 
shown in Figure 4 and maintained thereafter. Also, with this 
balancing control, although the further the pole positioned to 
the right half of the complex plane, the greater the control 
input becomes, the control system can be quickly stabilized. 
[4] With the dynamic models expressed as equations (22) and 
(23), assuming that the attitude control arm (6) is removed and 
the wheels (1) are almost stand still to ignore the motion 
related to the wheels (1) and approximation of sin 81 « ei is 
performed, the following motion equation can be established: 

-J|ffi»r t 0|-m|g*0i-O 

• ■ • (59) 

Feedback of u(t) = T3 is provided to the system expressed as 
Equation (59). 

Ji ii-oi i - u (t) 

C K*, (t) 

•••(60) 

Note that this is a constant determined by the torque 
function of the wheel driving motor (7), deceleration ratio of 
driving system, etc. 

21 



CZ"]Di) 



T 



2) 



(8,. 8;. e,) cii<Dwa» | ^| 



[ agaae.uu,. a*. 8a) w wat | 4) 



I 



I 



(8t. 8 2 . 6 3 ) m) ; (8i. 8i. 6 3 ) w 



T 



6) 



7) 



Figure 11 (c) 

Key: 1) Start; 2) Control circuit initialization; 3) (81, 82, 
and 83) (i) incorporation; 4) Compute (81, 82 # and 83) (n) using 
numeric differentiation; 5) Time- varying feedback gain Kt 
computation; 6) Compute control torques T2 and T3 from equation 
(49 and 51) comprised of (81, 82, and 83) (n) and (81, 82, and 
83) (n) and established feedback gain K; 7) Computation control 
torque T2 and T3 output. 
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Considering the overall control delay time AT [e.g., 
detection of tilt angle 91, computation time by the computer 
(16) , command input time for wheel driving motor (7), transfer 
delay by the deceleration gears (8), etc.]/ the equation (60) 
becomes the following: 

- - e k i < t —at) 

• ' • (61) 

By Taylor-developing 01 (t - aT) while ignoring the two 
dimensional small values, the following equation is made: 

0 i <t~AT>**|(t)-AT*i(t). 

As a result, equation (61) becomes the following: 
j i «,» ( r i-k I at) hi 

+ ( K € -mi i £ ) *i - 0 

. . • (62) 

The following characteristic equation can be obtained by 
Laplus-transforraing the equation (62): 

J l **♦ ( f i- K CAT) i 

+ <K€-mti<)-0 

••-(63) 

The stabilization condition for the control system expressed 
as equation (63) can be obtained as below based on the Routh- 
Hurwitz stabilization conditions: 

»i J«/e<K<UT 

-•(64) 
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With equation (64), although the lower limit of the feedback 
gain K is fixed, the upper limit varies depending on the delay 
time aT- That is, smaller the aT is, the greater the selection 
range of feedback gain becomes, and the selectability of 
appropriate feedback gain K becomes higher. 

The computer simulation result performed on equation (62) 
using feedback gain K selected from equation (64) exhibits the 
attitude stability control equal to the stable attitude stability 
provided to the linear control system described above (refer to 
[3]). For example, the attitude stability is excellent when aT = 
3ms and K = 10.0. 

Also, the experiment results on the control system expressed 
as equation (62) confirm that no negative results occur with the 
use of sampling time At when the delay time is aT. 
[5] The feedback controls described above are all based on the 
polar position method. The following explains the feedback 
control using an optimal control method: 

The control system shown in Figure 3 is expressed as 
equation (10) : 

x ( t ) -x- X { t ) + B • u ( t ) 

•••(10) 

The control input u(t) is then determined from equation (10) 
to minimize the evaluation function J(u): 

J ( u ) - I X ( t ) Q * X ( t ) 
' 0 

T 

+ u(t)RU(t))dt 
•••(28) 
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where Q and R are respectively 4x4 and lxl absolute symmetric 
matrixes* By minimizing J(u) as much as possible, the initial 
condition can be maximally stabilized with a small control 
energy. The optimal input uo(t) which minimizes J(u) can be 

obtained as equation (31) from the solution P of the Riccati 
equation (29): 



A P + PA-PBR 'bP+Q-0 

• - • (2 9) 

K - - R 1 BT • * • (30) 

u 0 ( t ) - K • X ( I ) ---(31) 



Therefore, by obtaining K, the optimum input uo(t) can be 
produced in the form of feedback. 

The feedback gain K for the conditional equation (16) 
expressing the controllable system shown in._Figure (3) can be 
obtained in the following manner: 

(1) Appropriate diagonal matrix Q and R are selected. 

(2) K (i = 0) is selected to stabilize A + BK (K computed in the 

polar positioning method is used for simplification) . 

->-» 

(3) Assuming Ai = A + BKi, 4x4 semi-absolute symmetric matrix 
solution P of the Lyapnov equation (32) is obtained. 

... (32) 
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(4) Return to (3) after setting Ki+1 = -R~ 1 B T Pi and i = i + 1. 

-> -> 

By repeating those processes, the convergence value K of Ki 
can be obtained. 

The weight Q and R in the evaluation function (28) strongly 
affect the control capability of the control system, and 
according to the results of experiments conducted by the 
developer of this invention, smaller the ratio of R to Q is, the 
faster the controlling speed becomes. Also, with the dynamic 
mode shown in Figure 3, since the stability of the car part (17) 
is more important than stability of the arm part (18), Q must be 
delibe-rately selected so that greater weight can be placed to 
the diagonal element of Q corresponding to XI. For this reason, 
the optimum control method is better than, the polar positioning 
method. As described with the simulation result obtained with 
the polar positioning method, The simulation result obtained from 
the optimum control method returns the car part (17) to the 
balanced position (01 = 0) (see a broken line in Figure 4), and 
the balanced condition can be maintained thereafter. 
[6] The following explains the design of a non-linear type 
control system of the dynamic model shown in Figure 3: 

With the linear type control system, an assumption was made 
that the dynamic model shown in Figure 3 was constantly 
controlled to prevent excessive 61 and 02. With the non-linear 
type control system, the following assumptions are made; 
(1) The slant angle 01 of the car part (17) is controlled so 
that it does not become excessively high. 
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(2) The rotational acceleration speed 93 of the wheel part (19) 
is extremely narrow. 

(3) When the slant angle 61 of the car part (17) is wide, the 
angle speed 61 is narrow. 

(4) When the slant angle 62 of the arm part (18) is wide, the 
angle speed 61 is narrow. 

(5) When the angle speed 61 of the car part (17) is wide, the 
slant angle 61 is narrow. 

(6) When the angle speed 62 of the arm part (18) is wide, the 
slant angle 62 is narrow. 

With those assumptions (1-6), equations (5), (6), and (7) 
expressing the dynamic model shown in Figure 3 can be simplified 
as described below: 



Ai *i»Bi -cos 9 t if,»E| *itf t 'a t -o 
••(33) 

Bi -cos 9 t V l)Bl 9 JlE2 • si. 9 2 

• • (34) 

C| *|iC 3 -cos *, if z iC) )f,*f, j 3 - Tj 

• • (35) 

t a b | ,-E| 'i > 



(36) 



f - | f A| B| * C O 9 £ 2 1 

' < 4 ' *Bi-cos*, B» > 

• • • (37) 

Ti 1 -Tj - E t ' * i» 9 t — I t 9 2 

• • • (38) 
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Then, the following vector and matrix displ 



ay are performed: 
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As a result, equation (34) is rewritten into the following 
conditional equation (39): 



e (t) - A- e (t) + b • t 2 • (t) 

- * (39) 



. Since A in equation (39) is a coefficient varies with the 
passage of time (time- variation) , at least one pole is positioned 
at the right half of the complex plane, where the system 
expressed as equation (39) is known to be unstable. In order to 
fix the time-varying pole in the unstable system at a position in 
the left half of the complex plane to stabilize the system, the 
following feedback control is performed to the system expressed 
as Expression (39): 

Ti • - [k i. ki, k*. k 4 ) 1 9 t . 9 e Jt *« ) T 
-K8 f 

- • * (40) 

As a result, expression (39) can be made into the following 
equation: 



me 



8 (1) - (A + BK )e (I) 



(41) 



The characteristic polynomial of equation (41) (i.e., the 
inherent polynomial equation A + W) becomes the following: 
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D ( i ) 

- d e t { iT- (X+ BK )l 

- I 4T-T- B ic I 

- J * + (a fj-bki-tki)-! 1 

+ C a E i- b k i- c k j- f | k «'/A) i * 
- ( * i * it Bi k «) X / A - Ei k 3 / A 
• • • ( K 2 ) 

where a = ac - b 2 . 

Since the poles in the system expresses as expression (41) 
are all assumed to be fixed, the coefficient in the equation 
(42) must 

not change with the passage of time (non-tirae-varying) . Since A 

-> " " ' -> 

and B are time-varying coefficients, K naturally becomes time- 

-> 

varying. To obtain this time-varying K (from here, expressed as 
-> 

Kt), one preferably stable linear non-time-varying model 
expressed as Expression (43) is selected.. 

XU) - A" % - X ( t) •••(43) 

As the control system expressed as equation (41) always 
agrees with equation (43) [i.e., the poles in the system 
expressed as equation (41) can agree with and is fixed to the 
poles in the system expressed as expression (43)], the control 
system expressed as expression (41) can be stabilized. The poles 
for the equation (43) are expressed as below:. 

-ctl + Bl j (a > 0, i = 1, 2, 3, 4) 

This characteristic polynomial is expressed as below: 
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D ( i ) - I H - A ' I 

X 0 0 0 
- 0 * 0 0 
0 0 J o 
0 0 0 x ' 
.-ai^ij Q 0 0 

0 - fill o 0 
0 0 - a 3* * si 0 

0 0 0 - *r «♦ fi *i 

- J *♦ d i J *» d t * ♦ <* • 

..-(44) 

i 

By consistently coincide the coefficient of the ^ ? 
characteristic polynomial in equation (42) with the 

characteristic polynomial of the equation (43), each element (kl, i 
k2, k3, k4) of Kt becomes the following: 

k| -l/b-( » Bfdi»(| di/Ei 

- c A d|/Ei- f i* do/Ei*) 

•—(45) 
k 2 -1/b ■{ » Ii-djicAdi/Bi 
+ f , c A d o/E !«) 

- - • (46) 

kj — — Ado/ Ei 

-(47) 

k« - (A/ Ei) • ( I i do/Ei-d i ) i 
...(48) 

The poles in the equation (39) expressing the time-varying 
system produced by those computations consistently coincides with 
the poles (-al + 131 j) of the stable linear time-varying model 
. (41), and the feedback coefficient Kt is made into a time-varied 
quantity at each, sampling time by equations (45) ~ (48). That 
is, this feedback becomes a kind of adaptation-control process, 
which is a model-matching process to the time-varying /619 
system parameters • 
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The control input Tl of the arm part (18) can be obtained 
from equation (38) by the following method: 



T* -T 2 ' + Ej • si» * *♦ f 2 9 t 
- K I 0 4- Ei • *U 9 2* t 2 it 

•-•(49) 



The control input T3 for the wheel part (19) can be obtained 
from equation (35): 

Tj-ci J|>C2 * COS *♦ CJ* 

- [ c i. c 7 • cos 6 , .) ( °. 1 1 + f i 9 J» C j 9 , 

K 9 2 

By substituting equations (37) and (40), the following 
equation is made: 

f a 6 

■ [ « i. c j - cos 0 j ) 

b c 

r - E | 9 t - I » 0 i x . 

* K t * 6 ' 

- • - (SO) 

By entering a control input that can approximate the angle 
speed 03 of the wheels (2, 3) close to the target angle speed 63, 
the wheels (2, 3) can be transferred at equal speed. Therefore, 
the control input for the wheel part (19) is expressed as below: 

I* b 
b c 



r - Ei » i- f t # i « . . . 

x [ ~ - J + r J 9 U Cit9 i-9 j •) 

• • (51) 
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The time-varying feedback gain Kt is computed from the 
sampling condition quantity (61/ 62, 83) of each time. Parts 
(a), (b), and (c) in Figure 7 shows the computer simulation 
result performed on equation (39) using those computed values. 
The curves (C5, C7, C9) shown in Parts (a), (b) , and (c) in 
Figure 7 designate the variation of the slant angle 61 of the car 
part (19), and curves (C6, C8, CIO) designate the variation of 
the slant angle 62 of the arm part (18). The parameters and 
conditions for those simulations are the following: 
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K i - (4.88. 1.31. 5.37. 6.00 ] 
X(0) -CO. «/l 0. 0. 0) 

Note that the X(0) = [0, ri/10, 0.0] expresses the initial 

condition, and a disturbance rr/10 (rad/s) is provided to the car 
part (17), where the duration of 10 ms is used as simulation 
interval At. 

The pole (Si) in Part (a) in Figure 7 is expressed as: 
Si = (-3±4j, -4±5j) (i = 1, 2, 3, 4) 

The pole (Si) in Part (b) in Figure 7 is expressed as: 
Si = (-5±4j, -6±5j) 
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The pole (Si) in Part (c) in Figure 7 is expressed as: 
Si = (-7±4j, -8±5j) 

The simulation results shown in Parts (a), (b), and (c) in 
Figure 7 indicate that the car part (17) can be returned to the , 
balanced position (81 = 0) (see a chained line shown in Figure 2) 
and maintained at the position thereafter. Also, with this 
balancing control, although the further the pole is positioned to 
the right half of the complex plane, the greater the control | 
input becomes, the control system can be quickly stabilized. 7620 f 

The computer simulation results of system designs described 
in [2] - [6] all exhibit the control effectiveness of the dynamic 
model shown in Figure 3 and Figure 4. The coaxial two wheeler 
shown in Figure 2 is formed based on this theoretical argument. 
The schematic of the control system for the coaxial two wheeler 
is shown in Figure 10, and a control program shown in Part (a), 
(b), or (c) in Figure 11 is stored in the computer (16). The 
control program shown in Parts (a) and (b) in Figure 11 

correspond to the linear type control system, whereas the control j 
program shown in Part (c) in Figure 11 corresponds to the non- i 
linear type control system. 

With the linear type control program shown in Part (a) of 
Figure 11, the computer (16) initializes various control circuits 

i 

(e.g., counter circuit, output interface circuit, data latch 
circuit, etc.) when a control initiation signal is inputted, and 
processes detection signals outputted from the rotary encoder 
(11) via a counter circuit. The computer then computes the 
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control torque (T3) using the equation (60) consisting of the 
sampled value 61 and pre-established feedback gain K, and outputs 
the computed control torque (T3) to the drive part via a data 
clutch circuit and D/A converter shown in Figure 10. The data 
clutch circuit holds the output data transmitted from the 
computer (16) until the next sampling point is reached. 

With the linear type control program shown in Part (b) in 
Figure 11, the computer (16) initializes various control circuits 
(e.g., counter circuit, output interface circuit, data latch 
circuit, etc.) when a control initiation signal is inputted, and 
simultaneously processes the detection signals outputted from the 
rotary encoders (11, 14, 15) via a counter circuit. The computer 
then computes the differential values of the nth sample (61, 62, 

63) selected from the n groups (61, 62, 63) (i) (i = 1, 2 n) 

[i.e., angle speeds (61, 62, 63) (n)]. 

The computer then computes the control torque (T2 and T3) 
using the equation (20) comprised of sampling values (61, 62, 63) 
(n), computed values (61, 62, 63) (n), and pre-established 
feedback gain K. The computed control torques (T2 and T3) are 
output to the drive part via the data latch circuit and D/A 
converter shown in Figure 10. 

With the non-linear type control program shown in Part (c) 

in Figure 11, the computer (16) performs the same process as 

described in the linear type control program up till the angle 

speed computation process using numeric value differentiation, 

-> 

and then computes the time-varying feedback gain Kt. The 
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computer (16) computes the control torques T2 and T3 using 
equations (49, 51) comprised of sampling angles (81, 92 , 03) (n), 
computed angle speed (81, 82, 03) (n), and pre-set time-varying 
feedback gain Kt, and transmits those torques (T2, T3) to the 

drive part via the data latch circuit and D/A converter shown in 
Figure 8. 

The following explains the numeric value differential method 
performed by the linear and non-linear control programs: 

Sampling time At [i.e., between the incorporation times of 
(01, 82, 03) (1) and (01, 02, 03) (t+1)] is sufficiently small, 
the angle 0i (i = 1, 2, 3) can be approximated by a two- 
dimensional polynomial described below: 

6i(t) » a + bt + ct 2 

...(52) 

By differentiating the equation (52), the angle speed 01(t) 
can be obtained in the following manner: 

0i(t) = b + 2ct 

. . . (53) 

The sum of squares of the difference of observation angles 
0i(l), 0i(2), 8i(3), 0i(4), and ©i(5) at the n pieces of sampling 

points (5 pieces in this example) 
tl = -At t2 = -At t3 « 0 
t4 = At t5 = 2At 

and 0i can be expressed as below: 



34 



ei(2>] 
ei(4)] 

f. 

i. 

7621 

j 

The coefficient a, b, and c of the equation (52) are 
determined in the following manner to minimize the value, of M e": 

a - (1/70) - (-8 9 i U)*24 9 \ (2) 

♦ 34 ^ I D> + 24 * i W-60 (SI) 

b - (1/10 A t ) - (- 2 0 i (1) - 0 I C2> 

« 0 1 ft) ♦ 2 0 ! (5» 

c - (1/14 A t » ) • (2 0 i U> - 0 I G) 

- 2 0 I 0) - 0 i ft)-2 0 I C5)) 



& = [9i(l) - 6i(l)] + [ei(2) - 
+ [Oi(3) - 8i(3)] + [6i(4) - 
+ [0i(5) - Bi(5)] 

- I 0 i (l> - (iMbA. I + 4 c A t ») 1 * 
+ 101 Q> - (a + bAi+cAt 1 )) * 
+ ( 0 i (3> - a > » 

♦ (01 Ml- <a+bAi + cAt*)) 1 

+ (01 (51 - (a+2bAt+4cAt 1 ))* 



By substituting the a, b, and c determined in this manner to 
the equation (53), the angle speed 8i(n) at each sampling point 
(n = 1, 2, 3, 4, 5) can be obtained. For example, the angle 
speed at the sampling point (t) can be expressed as below: 

ff IW- b ♦ 2 c • 2 A I 

- (1/10 A i ) • ( 26 0 i U)-2T 0 I ® 

-40 0 i W-13 9 i I4U54 0 i C» ) 
-•(5 4) 

That is, the angle speed 9i at the sampling point (t) is 
computed while the angle 6i at the sampling point is smoothed 
based on the past five sampling angles 8i(l) - 6i(5), and the 
computed angle speed with a smoothing effect precisely agrees 
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with the actual angle speed. 

The length of the sampling time interval At affects the 
stability of the control system. The smaller the At is, the 
better the results become, where the computation speed of the 
computer (16) between two sampling points determines the interval 

At. Therefore, the equations (45) -.(48) for computing each 

-> 

element of the time-varying feedback gain Kt in the non-linear 
type system are rewritten, in the following manner: 

k i -(1/ b) • ( aBfdttd dt/Bi 
- c A d»/Bi- f i'd,/E,») 
-U/ b) •( aBi-dflt k|/A-ck,) 
•*(55) 
2 - <!/ b) • ( a f |- d 3 * c A d i/B i 
+ i i cAd,/Ei») 

- (1/ b) - ( af,-dj.ck,) 

•••(56) 

Itj - -Ad,/E| 

••(57) 
* « - ( A/Ei) • (f | d o/Bi-d i ) 

- - (l/B|)-( d| A + l, k,) 

••(58) 

Using equations (55) - (58) instead of equations (45) ~ 

(48), 

-» 

the time-varying feedback gain Kt computation time can be 
drastically reduced. 

Parts (a), (b), and (c) in Figure 8 show the feedback 
control results for the coaxial two wheeler shown in Figure 4 
where the wheeler was controlled using the system parameter 
values and initial disturbance identical to those used with the 
linear type control simulation performed on the dynamic model 
shown in Figure 5, and operated at conditional feedback gain K = 
[4.88, 1.31, 5.37, 6.00] obtained for each pole Si = (-3± j, -4± 
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25). The curve (Cll) shown in Part (a) in Figure 8 designates 
the variation of the slant angle 01 of the car part j( 17), and 
curve (C12) designates the variation of the rotational angle 63 
of the wheel (19). The curve (C13) shown in Part (b) in Figure 8 
designates the variation of the angle speed 91 of the car part 
(17), and curve (C14) designates the variation of the control 
torque (T3). The results shown in Parts (a) * (c) in Figure 8 
indicate strong stability of the system during the movements of 
the wheels (2, 3) allowing the car part (17) to immediately 
regain the balanced position after experiencing a significant 
disturbance. 

Parts (a) and (b) in Figure 9 show the feedback control 
results when a coaxial two wheeler shown in Figure 2 operated at 
the target of 03 = 3 rad, where the system parameters were equal 
to those used in the non-linear type control simulation for a 
dynamic model shown in Figure 3. The curve line (C15) in Part (a) /622 
in Figure 9 shows the variation of the tilt angle 01 of the car 
body (17), curve line (C16) in Parts (a) and (b) in Figure 9 
shows the variation of the rotational angle 63 of the wheel part 
(19), and curve line (C17) in Part (b) in Figure 9 shows the 
variation of the angle speed 01 of the car body (17). In Parts 
(a) and (b) in Figure 9, as the car part (17) is slightly 
fluctuating at the beginning, the control process for moving the 
wheels (2, 3) is performed in the direction preferred for 
stabilizing the attitude of the car body (17), controlling the 
wheels at short intervals. The arm part (18) also slightly 
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fluctuates in the same phase as that of the car body part (17) 
after the wheels (2, 3) start moving, and the fluctuation 
movements of the arm part (18) and car part (17) become 
synchronous approximately 7 seconds after the initiation of the 
wheel movement, causing the arm part (18) to greatly fluctuate. 
At this point, the wheels (2, 3) rapidly get close to the target 
position. The stability of the car part (17) during the 
acceleration process suppress the fluctuation of the arm part 
(18). The wheels (2, 4) starts decelerating at approximately 9th 
second. The instability of the car part (17) caused by this 
deceleration is compensated by the intermediate fluctuation of 
the arm part (18). The coaxial two wheeler stops slightly before 
the target position 03 = 3 rad. This is probably because of the 
friction of the solid parts of the wheel driving system. 

The control effect of this device when the target position 
is set to 93 = 0 was identical to the condition after the car 
stopped moving [see Parts (a) and (b) in Figure 9]. 

When the fluctuation of the car part (17) during the 
motionless period of the wheeler was compared between Part (a) in 
Figure 8 and Part (a) in Figure 9, the attitude control method 
which simultaneously drives the wheel part (19) and arm part (18) 
could suppress the fluctuation of the car part (17) far better 
than the method which could only control the attitude. 
Therefore, the coaxial two wheeler equipped with an attitude 
control arm (6) shown in Figure 2 is proven to be more effective 
in controlling the attitude of the wheeler than the coaxial two 
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wheeler not equipped with an attitude control arm. 

The developers of this invention conducted an attitude 
control experiment using only the attitude control arm (6). As a 
result, neither the linear or non- linear type control system 
could stably maintain the car body (17) at a balanced position. 
This is probably due to the control delay caused by the non- 
linear type elements (e.g., non-sensitive area of the motor (9) 
for driving an attitude control arm or back- lash of the gear 
transmission' system, etc.) and the noise occurring during the 
angle speed computation performed based on the short-interval 
sampling of the slant angle of the car and attitude control arm 
(6) utilized with feedback control, revealing the difficult 
adaptation of the conventional attitude control method using only 
an attitude control arm ( 6 ) . 

This invention is not limited to the operational example 
described above, and any modifications (e.g., providing a 
steering capability to the coaxial two wheeler by connecting the 
wheels (2, 3) and wheel driving motor (7) via a differential 
movement gear system, a pair of wheels (2, 3) are independently 
driven to provide a steering function]. 
[Effectiveness of this invention] 

With the first claim of this invention, the tilt angle of a 
car detected by the first angle detection device is sampled at 
short intervals, and the control torque for the wheel driving 
motor is computed based on the sampled data, and the feedback 
control is performed on the wheel driving motor based on the 
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computed control torque. As a result, this makes the wheels to 
be shifted in the slant direction of the car body to provide an 
immediate positional recovery of the car body. 

With the second claim of this invention, the tilt angle of a 
car detected by the first angle detection device and wheel 
rotation angle detected by the secondary angle detector are 
sampled at short intervals; the sampled angles of the car body, 
rotational angle of the wheels, and angle speed computed based on 
those sampled angles are entered into the computer as conditional 
variables. Those values used as control variable and feedback 
gains used as coefficients are substituted in the pre-stored 
control equations stored in the computer to generate a control 
torque of the motor; the computer can control the motor by 
feedbacking the computed torque.. As a result, when the car body 
is slanted, the wheels can be operated in the same slant 
direction of the car body to assure the car body to regain the 
original position. 

With the third claim of this invention, the tilt angle of a 
car detected by the first angle detector, wheel rotation angle 
detected by the secondary angle detector, and slant angle of the 
attitude control arm detected by the third angle detector are 
sampled at short intervals. The pre-stored control input 
computation equations are computed by substituting the sampled 
angles of the car body, rotational angle of the wheels, slanted 
angle of the attitude control arm, and angle speed computed based 
on the sampled angles as conditional variables and feedback gains 
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as coefficients. The control torques for the wheel driving motor 
and attitude control arm driving motor are computed based on the 
equation computation described above, and the computer controls 
the wheel driving motor and attitude control arm driving motor 
according to the control torques, allowing the motors to be 
feedback-controlled. As a result, when the car body is slanted, 
the wheels are operated in the same direction of the slanted car 
body, while the control arm is rotated in the direction opposite 
to the slant direction, assuring the car body to regain t.he 
original attitude. With this method, the use of an attitude 
control arm can more assuredly maintain the balanced position of 
the car body than the first and second methods. 
4. Simple explanation of the figures 

Figure 1 shows the diagram of the device used to explain the 
third claim of this invention, and Figure 2 shows the cross- 
sectional diagram of the device shown in Figure 1. Figure 3 
shows the diagram of a dynamic model of simplified system 
displayed in Figure 2. Figure 4 shows the diagram of the side 
surface of the device used in the operational example. Figure 5 
shows the diagram of the side surface of a dynamic model. Parts 
(a) and (b) in Figure 6 show the computer simulation results of 
the dynamic model in Figure 5, where Part (a) shows a graph 
exhibiting the variation of the slant angle 91 and rotations 
angle 63 of the wheel (19), and Part (b) shows a graph exhibiting 
the variation of the angle speed 9 and rotational angle speed 03. 
Parts (a), (b), and (c) in Figure 7 shows the computer simulation 
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results performed on the dynamic model in Figure 3, where part 
(a), (b), and (c) respectively show the graph exhibiting the 
variation of slant angles 91 and 62 of car part 17 and arm 18 
based on the selected pole Si = (-3±4j, -4±4j), pole Si = (-5+4j, 
6±4j), and pole Si = (-7±4j, 8±4j). Parts (a), (b), and (c) in 
Figure 8 show the feedback control results of the coaxial two 
wheeler shown in Figure 4; where part (a) shows the graph 
exhibiting the variation of slant angles 61 and rotational angle 
03 of wheel (19); part (b) shows the graph exhibiting the 
variation of rotational angle 63 of wheel (19); and part (c) 
shows the graph exhibiting the variation of control torgue. 
Parts (a) and (b) in Figure 9 show the feedback control results 
of the coaxial two wheeler shown in Figure 2; where part (a) 
shows the graph exhibiting the variation of slant angles 61 and 
rotational angle 63 of wheel (19); part (b) shows the graph 
exhibiting the variation of rotational angles 63 and slant angle 
62 of the arm part (18). Figure 10 shows the diagram of the 
coaxial two wheeler shown in Figures 1 and 2. Part (a) in Figure 
11 shows the flow chart of a linear type control program. Part 
(b) in Figure 11 shows the flow chart of another linear type 
control program. Part (c) in Figure 11 shows the flow chart of 
non-linear type control program. 

1... Axil; 2, 3... Wheel; 4... Car body; 6... Attitude 
control arm; 6a... Weight; 7... Wheel driving motor; 9... 
Attitude control arm driving motor; 11... First angle detection 
device rotary encoder; 14... Second angle detection device rotary 
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encoder; 15... Third angle detection device rotary encoder; 16... 
Computer; 17... Car body; 18... Arm; 19... Wheel part; ei, 92, 
63... Angle; 61, 62, 63... Angle speed; T2, T3... Control torque; 
-> -> 

K, K, Kt... Feedback gain 




43 



WWWWW 




44 



0.1 



OAS 
0 

-0D5 

-0.1 

-0.15 

-05 

-025 

-03 

-035 



-0.4 



'626 























r \ 






"<C5(0D / 




























/c6©2> 























































b) 



05 $ 



1j03 



153 




Figure 7 (a) 

Key: a) Angle (irad); b) Time (S) 
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Figure 7 (c) 
Key: a) Angle (rad); b) Time (S) 
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Figure 8 
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Figure 10 

5SAr. J? ?rive part; 2) Motor 9; 3) Encoder 15; 4) Encoder 14; 5 
? 6 Drive part; 7, 8, 9) Counter circuit; 10) Encoder 11 

12) Control computer. 16; 13) D/A converter; 14) Data latch 
circuit; 15) Data latch circuit; 16) D/A converter 
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Figure 11 (a) 

Key: 1) Start; 2) Control circuit initialization; 3) 91 
incorporation; 4) Compute control torque T3 from equation (60) 
comprised of 91 and established feedback gain K; 5) Computation 
control torque T3 output. 
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Figure 11 (b) 

Key: 1) Start; 2) Control circuit initialization; 3) (81, 02, 
and 93) (i) incorporation; 4) Compute (91, 02, and 93) (n) using 
numeric differentiation; 5) Compute control torques T2 and T3 
from equation (20) comprised of (91, 92, and 93) (n) and (91, 92, 
and 93) (n) and established feedback gain K; 6) Computation 
control torque T2 and T3 output 
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